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An adaptive controller is developed for adjusting robot 
arm parameters while manipulating payloads* of unknown 
mass and inertia. The controller is tested experimentally in a 
master f slave configuration where the adaptive slave arm is 
commanded via human operator inputs from a master . 
Kinematically similar six-joint master and slave arms are 
used with the last three joints locked for simplification . 
After a brief initial adaptation period for the unloaded arm, 
the slave arm retrieves different size payloads and 
maneuvers them about the workspace. Comparisons are 
then drawn with similar tasks where the adaptation is turned 
off. Several simplifications of the controller dynamics are 
also addressed and experimentally verified. 


1.0 INTRODUCTION 

Whether working in space, undersea, or on the ground, 
humans and robots must often contend with operating in an 
uncertain environment. One key characteristic often left 
unspecified is information about the object being 
manipulated. In the work presented here, a parameter 
identification scheme is used to estimate the parameters of 
the robot when maneuvering an unknown payload. The 
effect on performance of the improved model in tracking 
desired workspace trajectories is then examined. 

The paper begins by giving the dynamics for the first 
three links of a parallel linkage robot arm. The parameters to 
be used in the identification algorithm are formulated from 
the link parameters. A parameter adaptive controller is 
developed for the slave arm which contains both a model- 
dependent feedforward term and a position/velocity feedback 
term. The master arm uses the same feedback as the slave 
arm with a reversal in sign. The algorithm is then tested 
experimentally on the teleoperated system doing payload 
retrieval tasks. 


Because of the parallel linkage used to drive the third 
joint (see Fig. 1), the Kraft arm dynamics could not be 
derived using recursive algorithms such as the Lagrangian 
Method or Newton-Euler Method (see Paul [2]). Instead, 
the method presented in Asada and Youcef-Toumi [3] was 
used, which is Lagrangian-based but does not assume open 
kinematic chains. Also pertinent to the development of the 
dynamics is the use of actuator coordinates and joint 
coordinates which need not be synonymous for parallel drive 
mechanisms. The reader is again referred to [3] for a 
discussion on this topic. 


Following the procedure of Asada et al [3], the dynamics 
for the arm is derived in the form 

1 = Hft + Cfi + Ig + D c sgn(fl) + (1) 

The matrix C is not unique and is chosen to be 



9H ik 9H ik x 

30j 36i J 


e k 


( 2 ) 


because of its unique property of yielding the skew 
symmetric sum, H - 2C. This is important in the 
formulation of the adaptive controller. H, C and i g for the 
Kraft arm arc given in the appendix. D c and are diagonal 
matrices representing the magnitude of the coulomb friction 
and viscous friction coefficients, respectively. 


Table 1 : D-H Parameters for Kraft Minimaster. 


1 

an (m) 

on (deg) 

d|(m)* 

1 

0.000 

0 

0.000 

2 

0.000 

-90 

±0.075 

3 

0.180 02) 

0 

±0.055 


2.0 DYNAMICS 

A set of minimaster hand controllers manufactured by 
Kraft Telerobotics Inc. was used in the teleoperation 
experiments: the left arm was used as the master and the 
right arm as the slave. Except for the right/left symmetry, 
the two arms were identical. The Denavit-Hartenbcrg 
Parameters (see Craig [1]) for the first three links of the 
Kraft arm arc given in Table 1. 


* the right arm has positive offsets in this coordinate convention and 
the left arm has negative offsets (note: d2~bi and d3*b2-bi in Fig. 1). 


3.0 CONTROLLER 

The adaptive controller used in this study is the one 
developed by Slotine and Li [4], As in the computed torque 
scheme, it contains feedforward terms to compensate for the 
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UNK 1 


The robot model, encompassed by the ” A " terms in (3), 

is linear in the model parameters £. p. is updated so as to 
ensure that the derivative of the Lyapunov function 

v(t)=^ c T Hc +^rH (5) 

is negative definite, where p=p-p, is the parametric error. 
The positive definite weighting matrix, T, is usually chosen 
to be diagonal. The parameter update law 

a = -r-iyr c (6) 



(b) 

Figure 1: Kinematics for first three links of Kraft arm 
showing (a) side view and (b) top view. 


dynamics, but it also has feedback terms to compensate for 
modeling uncertainty: 

Icom = + ^CJLfDftr + lg(Q) 

+ 6 c sgn(Q) + - Kcfi (3) 

where Or = fid - ^ fi 

fir = fid-XQ 

and fid(t) is the desired trajectory. The feedforward is 
adjustable through model updates, and the feedback, Kd&, 
through trajectory updates if Kd is constant. A block 
diagram depicting the control scheme is shown in Fig. 2. 

The only requirement on Kd is that it be positive definite. 
One desirable choice for Kd is kft (see Slotine and Li [5]) 
which produces a feedback which depends on the model 
updates as well as the commanded trajectory. This yields a 
control law of the form 

Scorn = ft{a)[fld-2XS-X 2 5j + (6(&£HV)[fid - X Q] 

+ Ig(fi) + 6 c sgn(fi) (4) 

which is approximately the same as a computed torque with 
critically damped error dynamics. 


where 

Yfi = + (fc-C)fl, + (l g -i g ) (7) 

yields a Lyapunov derivative 

V(t) - -fiT KD£ (8) 

thus ensuring stability for a positive definite choice of Kd. 
Because of their simpler form, the friction parameters have 
been omitted from (6) and (7) and are updated according to 
the analogous law 

c Ck sgn(6k) (9) 

( 10 ) 

where k denotes the joint, and is the (kjc) element of 
D c . If Kd is chosen to be Xft, then fir must be replaced by 
Sr-Xfi. in (7) to account for the possibility that h is not 

positive definite. T can be viewed as a gain which 
determines how quickly the parameters will adapt and is 
largely chosen heuristically. 

Though this formulation ensures stability of the tracking 
algorithm for correct model structures, it says relatively little 
about the convergence of the model parameters; it does, 
however, guarantee convergence for "persistently exciting" 
trajectories. What this terminology means in the nonlinear 
case is an area of ongoing research, although in an intuitive 
sense, it means the trajectory must excite the dynamics in 
such a way that incorrect parameters will produce significant 
differences between the modeled and observed dynamics. 

In the linear case, persistent excitation depends on the 
number of input frequencies used and how that relates to the 
order of the system. However, in tests where the number of 
input frequencies were varied, the convergence of the model 
parameters did not appear to be significantly effected in a one 
minute trial. It is possible that the speed of convergence 
depends more on other factors such as the number of 
parameters than on the degree of persistent excitation. 



Rgure 2: 8ch*mattc of maal»r/«Jav« tolooporator with direct adaptive controittr. 
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Asymptotic convergence is only guaranteed when the 
parameters appear explicitly in the Lyapunov derivative. In 
"composite" control formulations, both state feedback and 
torque feedback are used and the model parameters appear 
explicitly in V(t), However, improved convergence was not 
apparent for this scenario and was computationally 
expensive; thus the experiments performed here used the 
simpler, noncomposite form of control For more on this 
topic, the reader is referred to Slotine and Li [6]. 


4.0 EXPERIMENTS 

A photograph of the Kraft "slave’ 1 arm used in the 
teleoperation tasks is shown in Figure 3. Both arms are 
clamped at the wrist so that only the first three degrees of 
freedom in the base are active. A hook was attached to the 
clamp on the right arm enabling it to retrieve weights during 
the tests. The AC motors were driven by control units that 
were supplied by the arm manufacturer. 



Figure 3: Photo of Kraft arm manipulating payload. 


The only sensor information available was the position 
of the links supplied by potentiometers geared to the motor 
shafts. Velocity and acceleration information were obtained 
through differentiation and extensive filtering of the 
potentiometer data. A Compaq 386/20 equipped with 
coprocessor was used to derive the control laws and transfer 
data back and forth to the control unit The experiments 
were run at 81 Hz, the maximum rate achievable with the 

current software. The control bandwidth, X, was chosen to 
be 1/2 Hz, just slightly below the natural frequencies of the 
drive systems. 

In all tests, the subjects were asked to move the aim to 
pick up the weight from a table, move the arm back to its 

initial position, sequentially move the shoulder azimuth (0i), 

shoulder elevation (02)* and elbow (03) back and forth 
several times, and then to return the weight to the table. For 
each weight tested, the controller was first died with the 
adaptation turned on and then turned off. Prior to running 
all the tests, one adaptive run was made without a payload to 
obtain initial values for the arm parameters. These values 
were used in all subsequent runs as the starting parameters. 

The master and slave joint positions for one set of tests 
run with the 0.5 kg weight are plotted in Figs. 4 and 5. For 
the adaptive results shown in Fig. 4, the master and slave 
ang les w ere nearly indistinguishabl e. In the nonadaptive 


plots, however, the master and slave shoulder elevations and 
elbow angles differed a great deal. This is because of the 
increasing effect of gravity on the loaded arm as one 
progresses toward the payload. Since the gravity parameters 
are nonadaptive and the gravity forces dominate the inertial 
forces for moderate speeds, joint 3 differed gready from the 
commanded angle, whereas joint 1, whose axis was parallel 
to gravity, was relatively unaffected. 

It is almost possible to track the progress of the 
experiment simply by looking at Fig. 5: at 7 sec, the slave 
arm reaches the payload and begins pushing down on it 

(slave arm is impeded by the object so that 63 for the slave < 

03 of the master — pitch down produces positive 03); at 17 
sec, the arm starts lifting the payload and at 20 sec, the 
payload clears the table (the slave cannot lift the payload as 

high as the master arm so that now ©3 for the slave > 83 of 
the master). Beginning at 23, 35, and 45 sec, respectively, 
joints 1, 2, and 3 are moved back and forth, and at 57 sec, 
the payload is returned to the table. 

Although the joint angle errors provide a fairly good 
measure of the tracking performance, the tracking error 
provides the true measure of the control system 
performance. Figure 6 plots the tracking errors for these 
two tests on the same graphs. These plots reaffirm the 
conclusions reached earlier from observations of the joint 
angles. In the adaptive case, it is difficult to discern when 
the payload is picked up, whereas for the nonadaptive case,# 
this is relatively easy: at t=7sec, S3 begins rising rapidly, and 
at t=17sec, S2 also begins to rise as the payload is lifted from 
the table. 

The same experiments were repeated for retrieving a 1 kg 
weight, and results for joint 3 in the adaptive case are shown 
in Fig. 7. Even with a payload twice as large, the tracking 
errors are not significantly different from those of the 0.5 kg 
case in Fig. 6. This illustrates the ability of the tracker to 
maintain control performance when the arm’s characteristics 
are being significantly altered through interaction with the 
environment 

As a final test, several adaptive runs were made with 
structural simplifications in the model used by the controller. 
Figure 8 shows joint 3 results for a trial in which the velocity 

dependent terms, i.e. t {L 6 C , and 6,,, were ignored. In 
comparing Fig. 8 with S3 in Fig. 6, one can discern little 
degradation in going to the less accurate model. This is 
probably due to one of two reasons: the tracker was able to 
compensate for this inaccuracy through the adaptation of 
other parameters (for the friction parameters) or further 
modification of already existent parameters (for the Coriolis 
terms), or the neglected terms were insignificant for the 
particular tests which were run. The latter case seems 
unlikely for the friction parameters at least, since the 
coulomb friction forces were found to account for about 
20% of the peak torque. Whatever the case, ignoring these 
terms can significantly reduce the amount of computation 
and is a possibility which should not be overlooked for more 
complex systems. 


5.0 CONCLUSIONS 

This effort applied a parameter adaptive controller to a 
parallel linkage arm and tested the controller on a 
teleopc rated system. One purpo se of t h is tas k was to verify 
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Figure 4: Joint angles during adaptive man!- Figure 5: Joint angles during nonadaptlve Figure 6: Tracking errors for manipulation 
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that the adaptation algorithm would work even if the 
commanded inputs were provided by a human operator. 
Another was to investigate the differences, in terms of 
improved manipulation ability, between a controller with 
invariant characteristics and one which accomodates external 
perturbations. 

In experimental tests, the adaptive tracking algorithm 
was found to converge within several seconds following 
picking up or putting down a payload. This was an 
improvement over the nonadaptive controller where the 
errors built up considerably because of the inability of the 
feedforward to correctly compensate for the added 
gravitational forces on the arm due to picking up a payload. 
While this limitation did not unduly impede the operator in 
these tests, a more precise task would force the operator into 
moving the master arm along a "false 11 trajectory to achieve 
the desired motion in the slave arm. In a scenario dominated 
by inertial rather than gravitational forces, this inability 
would be manifested as large overshoots for the slave arm. 
In either situation, the range of motion for the slave arm may 
become severely restricted compared to the master. 

The only way to reduce the error without modifying the 
feedforward in the nonadaptive case would be to increase the 
feedback gains on the position and velocity errors. These 
gains can only be increased to a certain extent, however, 
before the natural frequencies of the arm are excited (~1 Hz). 
By contrast, the adaptive controller is able to maintain the 
same errors before and after a payload is picked up without 
changing the bandwidth. 



Figure 7: Joint 3 tracking error during adaptive manipulation 
of 1.0 kg payload. 



t(*ec) 

Figure 8: Joint 3 tracking error during adaptive manipulation 
of 0.5 kg payload without velocity feedforward. 


Because the gravity forces dominated the arm torques in 
these experiments, the desired trajectory played only a minor 
role in the parameter adaptation. This is bom out by 
observing that the joint 1 errors for the adaptive case 
decreased little if any over those for the nonadaptive case. 
(Joint 1 torques had no direct dependence on gravity.) For 
the trajectory to play a more important role, the inertial forces 
would have to be much higher relative to gravity. Thus it is 
not possible to extend all the conclusions drawn here on 
tracking convergence to a gravity-free environment. 

One drawback worth mentioning in using this approach 
for teleoperation occurs during contact of the robot arm with 
immobile objects. When the progress of the robot arm is 
impeded by an object such as a table surface, the adaptive 
controller begins modifying the arm parameters to reflect an 
increase in the mass of the arm which could account for the 
inability of the arm to continue along its path. As the arm is 
commanded away from the surface, die movement is delayed 
as the arm parameters readjust to the newly found freedom 
of motion. If the exact position and orientation of the 
surface were known (such as in a completely automated 
setting), then the arm-environment interaction could be 
modeled and the contact could be taken into account in the 
tracking errors and the false modification of the arm 
parameters would not take place (see Niemeyer and Slodne 
[7]). Thus during compliant motion, the adaptation should 
be turned off to prevent their adjustment during this 
interaction. 
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APPENDIX: KRAFT ARM DYNAMICS 


The capital H r ’s arc combinations of link inertias and mass 
x CM 2 terms: 


I = Hfi + Cfi + ig 
where 


PO+2piC3S3+p3S2 2 +p4S3 2 +p5C2 2 P12S2 P2C3‘P?S3 

+p7C3 2 -2piol2C2S3+2pi 1 C 2 C 3 

P 12 S 2 P 6 ‘Pl0l2S32+PllC32 

P 2 C 3 -P 9 S 3 -pl0l2S32+Pl|C32 pg 

' 3 -Mii 4 1 + ^Mi 2 e 2 


hzz = ilzz+miy! I2xx = i2xx + m 2 bj 

• 2 *22 
l2zz = *2 zz"*' ii ^ 2 x 2 I 2 yy — ^yy+n^J^+n^bj 

l3xx = >3xx +m 3y3+m3(z3+b2) 2 l3 xy = I3xy-ni3 x 3y3 
l3yy = *3yy +m 3 x 3 +m 3( z 3 + b2)^ l3xz = i3xz-nv}X3(Z3+b2) 


302 2 303 

1 3 Hiu 

' 2 aiT 1 


302 302 2 303 303 

0 2 Sa*, 


Ig = -P13C2 g 

P10S3-P14C3 


l3zz = i3zz+m3*3+m3y3 
2 

Uxx = Uxx +m 4hj 

2 2 

Ljyy = i 4 yy+m 4 X 4 +m 4 b 1 

Uzz = Uzz+ni4X4 

^35xx = I3xx+l5xx 
l35yy = l3yy + ^5yy 
I35zz = l3zz+I 5z z 


l3yz = i3yz+m3y3(z3+b 2 ) 

lSxx = hxx+n^bj 

2 2 

^5yy ~ t5yy +m 5 x 5 +m 5b3 
^5zz = i5zz +m 5X5 

l24xx = I2xx+l4xx 
I 2 4yy = I 2 yy+l4yy 
l24zz ~ l2zz+Uzz 


^ LL = 2(p3-p5)S2C 2 +2p 
002 

= 2 (p 4 -p 7 >S 3 C 3 + 2 p 

003 

= P1012C32+P1 1S32 
o0 2 


-p 5 )S 2 C 2 + 2 p iol 2 S 2 S 3 - 2 p 1 1 S 2 C 3 

■P7>S3 c 3 + 2p iCj- 2 p is^- 2 p iol 2 c 2 C 3 - 2 p 1 ic 2 S 3 


The CM positions in the local coordinate frames arc: 


2Scm 1 — I yi , £cm2 “ I 0 I » 21cm 3 — y3 


X 4 

2cm4= 0 


The link inertia tensors about the CM in the local coordinate 
frames are: 




"ilxx 

0 

0 ■ 


'I 2 xx 

0 

0 “ 

P 12 C 2 

1! = 

0 

ilyy 

~hyz 

. la- 

0 

I 2 yy 

0 


0 

"Uyz 

hzz 


0 

0 

t 2 zz 


302 

3Hn 

-^-•PM-PW 

= ‘pl0^2 c 32"Pl l s 32 

003 


fMxx 

0 

0 - 

O 

II 

"t-F 

hyy 

0 

L 0 

0 

Uzz 


P6^2Azz+^l2 


P8=l35zz + n04l 5 
P9“^3xz' m 4^5b 1 -m5X 5 b3 

Pl0=m3y3 

pi 1 =1113x312+114x415 

pi2^2X2bi+m4X4bi+m3l2(b2+Z3) 

p 1 3 =m 2 x 2 +m3l 2 ^m4X4 
pi4=m3X3+m4l5+tn5X5 


T *3xx “I3xy -I3xz 
I 3 = “bxy hyy "hyz 
"hxz ‘byz hzz 

p5xx 0 0 

Ij = 0 i 5 yy 0 

00 i$zz 


where the elements of I arc moments of inertia about various 
axes, e.g. ixxsjfty^+z^dm and i xy =JJxydm. 

The initial parameter values used in all the experiments were: 


P7=l35yy+ni4l 5 

*SjHsin 0 i and q=cos 0 i, S3 2 =sin(03-02) and C32®cos(03“02) 


po=0.0489 

p 1*0.0021 

P2—0.0214 

P3«*0.0521 

P4«0.0807 


P5=0.0973 

P6=0.3449 

P7=0.3999 

P8=0.5819 

P9=-0.0209 


piO=0.0523 

p n =0.0827 

P12=0.0088 

pl3=0.0650 

Pl4=0.0996 


P15*=0.0228 (coulomb, 1 ) 
pi 7 *=0.0536 (coulomb,2) 
pi9=0.0500 (coulomb, 3) 


pi6*=0.0302 (viscous, 1) 
p 18=0.0392 (viscous, 2) 
P 2 O=O 0248 (viscous, 3) 


t 


